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BACKGROUND OF THE INVENTION 
Field of the Invention (Technical Field) : 

The present invention relates to methods and apparatuses for reducing effects of 1 ) structural 
resonances in the control of mechanical structures, such as gimbaled turrets and 2) noise harmonics of 
time varying and/or uncertain frequency, such as the spin frequency noise in rate gyroscopes subject to 
power fluctuations. 

Description of Related Art : 

In the control of mechanical structures, such as gimbaled turrets, the frequency of structural 
resonances must be known so they can be cancelled with notch filters in the controller to keep the 
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feedback control loop stable. The present invention adaptively computes the frequency of the 
resonance in realtime during normal closed-loop operation of the controller to improve the accuracy of 
the frequency estimate and adapt to changes with time in the resonance frequency. With a rough initial 
estimate, the Realtime Adaptive Notch Compensator (RANC) of the invention solves for a more 
5 accurate estimate of the frequency and compensates the notch filter to stabilize the control loop thus 
minimizing oscillations due to the structural resonance. 

Structural resonances are problematic in that they are very narrow in bandwidth, they vary from 
system to system even with identical structure design, and, in a given system, may also vary with gimbal 
10 position, temperature, and vehicle high-g maneuvers. 

The conventional approach is to measure and characterize each system to determine the 
frequency at which structural resonances occur. Constant, dedicated notches are then placed at these 
frequencies to attenuate the resonance amplitude. These notches must be narrow in width; otherwise 
15 they will significantly degrade the controller's performance, in particular, the phase and gain stability 
margins. The emphasis on narrow notches increases the accuracy with which the structural frequency 
must be known, thus, making the measurement process lengthy and expensive. 

The frequency measurement process can be extended to generate look-up tables of frequency 
20 versus gimbal position, temperature, vehicle acceleration, etc. These tables can then be implemented 
in an open-loop fashion in the controller to set the notch frequency depending on gimbal position, 
temperature, vehicle acceleration, etc. The open-loop nature, however, provides no feedback indication 
that the frequency was adjusted properly to minimize oscillations. 

25 Another approach is to minimize the interaction of structural resonances with the controller by 

designing stiffer structures such that resonances occur at higher frequencies where they cannot be 
excited by the controller. The disadvantage is larger, heavier structures or structures built with 
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expensive materials. Alternately, the controller bandwidth is kept low (at the expense of performance) 
such that the controller does not excite structural resonances. 

Notch filters are also used to filter out noise harmonics in sensors such as spin frequency noise 
5 in rate gyroscopes. The RANC of the invention is also applicable in such application to compensate for 
variations in spin frequency due, for example, to temperature changes or power fluctuations. 

The prior art approach is exemplified schematically in Fig. 1, wherein an input signal 10 to be 
measured is corrupted by sensor 12 with harmonic noise of constant frequency oa n , which is processed 
10 by notch filter 14 at fixed frequency oj n , resulting in filtered output 16 and notch output error 18. The 
notch output error 18 is calculated via summing node 19 as the difference between the true input signal 
10 and the filtered output 16. 

BRIEF SUMMARY OF THE INVENTION 
15 The present invention is of a notch compensator comprising: means for receiving input to a 

notch filter; means for receiving output from the notch filter; means for dynamically calculating a desired 
change to a notch frequency of the notch filter; and means for specifying the desired change to the 
notch filter. In the preferred embodiment, the input receiving means comprises a first pre-filter providing 
a notch output error as output, the output receiving means comprises the first pre-filter, and the input 
20 receiving means comprises a second pre-filter providing a reference signal as output. The calculating 
means comprises demodulation means receiving input from the first and second pre-filters, with 
preferably the demodulation means providing a frequency error as output. The calculating means 
additionally comprises integral compensation means receiving the frequency error as input, preferably 
wherein the integral compensation means minimizes the notch output error. The demodulation means 
25 most preferably comprises a low pass filter that is second order with a bandwidth about one decade 
below an expected value of a next notch frequency. 
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The present invention is also of a notch compensation method comprising: receiving input to a 
notch filter; receiving output from the notch filter; dynamically calculating a desired change to a notch 
frequency of the notch filter; and specifying the desired change to the notch filter. In the preferred 
embodiment, receiving input comprises employing a first pre-filter that provides a notch output error as 
5 output, receiving output comprises employing the first pre-filter, and receiving input comprises 
employing a second pre-filter that provides a reference signal as output. Calculating comprises 
demodulating employing input from the first and second pre-filters, preferably wherein the demodulating 
step provides a frequency error as output. Calculating preferably additionally comprises performing 
integral compensation employing the frequency error as input, most preferably wherein performing 
10 integral compensation minimizes the notch output error. Demodulating most preferably comprises 

employing a low pass filter that is second order with a bandwidth about one decade below an expected 
value of a next notch frequency. 

The present invention is additionally of a notch filtering system comprising a notch filter and a 
15 notch compensator as described above. The system is useful in reducing structural resonances in 
control of mechanical structures, reducing noise harmonics of time varying and/or uncertain frequency, 
adaptive harmonic noise identification, adaptive harmonic noise filtering, and control of flexible 
structures. The system is also useful in control of gimbaled turrets, control of helicopters, stabilization 
platforms, gyroscopic rate sensors, computer hard drives, vehicle body bending compensation, and 
20 flexible robotic manipulators. 

Objects, advantages and novel features, and further scope of applicability of the present 
invention will be set forth in part in the detailed description to follow, taken in conjunction with the 
accompanying drawings, and in part will become apparent to those skilled in the art upon examination 
25 of the following, or may be learned by practice of the invention. The objects and advantages of the 
invention may be realized and attained by means of the instrumentalities and combinations particularly 
pointed out in the appended claims. 
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BR1EF DESCRIPTION OF THE SEVERAL VIEWS OF THE DRAWINGS 
The accompanying drawings, which are incorporated into and form a part of the specification, 
illustrate one or more embodiments of the present invention and, together with the description, serve to 
5 explain the principles of the invention. The drawings are only for the purpose of illustrating one or more 
preferred embodiments of the invention and are not to be construed as limiting the invention. In the 
drawings: 

Fig. 1 is a block diagram of prior art conventional notch filtering of harmonic noise in a signal 
10 processing application; 

Fig. 2 is a block diagram of the RANC signal processing of the present invention resulting in 
adaptive harmonic filtering; 

15 Fig. 3 is a block diagram of the invention employed in a rate and/or acceleration control loop for 

adaptive structural resonance compensation; 

Fig. 4 is a block diagram of the preferred RANC processing components and interface with the 
notch filter; 

20 

Fig. 5 is a block diagram of the preferred embodiment of the two pre-filters of the embodiment of 

Fig. 4; 

Fig. 6 is a block diagram of the preferred demodulation, post-filter, and compensation elements 
25 of the embodiment of Fig. 4; and 

Fig. 7 is a block diagram of a hardware-in-loop experimental implementation of the invention. 



-6- 



PETA1LED DESCRIPTION OF THE INVENTION 
The present invention is of an apparatus and method for control of mechanical structures with 
uncertain and/or time varying structural resonances (e.g., gimbaled turrets, seekers). The invention 
5 employs notch filters to provide stability in the presence of uncertain and/or time varying resonances. 
Resonances are narrow in bandwidth, vary from system to system even with identical structure design, 
and may also vary with gimbal position, temperature, and/or vehicle maneuvers (high-g, g-vector). 
Accordingly, notch filters must also be narrow in bandwidth to minimize phase margin loss which implies 
that the resonance frequency must be known accurately. 

10 

The present invention adaptively estimates the frequency of the resonance in realtime during 
normal closed-loop operation of the controller and compensates the notch filter to most effectively 
attenuate the resonance. The invention updates the frequency estimate to improve its accuracy from 
system to system - in a given system, the invention corrects for errors in the initial estimate and adapts 
15 to changes in frequency with time. Effectively, the invention also minimizes oscillations due to the 

resonance over the entire system operating range, which results in improved overall stabilization (e.g., 
for line-of-sight control for a gimbaled turret). 

The present invention is preferably implemented in the controller as a stand-alone algorithm 
20 running in parallel with a pre-existing conventional notch filter (Figs. 2-3). The RANC monitors both the 
input to the notch filter and its output. In return, the RANC compensates the notch filter with an updated 
estimate of the resonance frequency. The invention updates the estimate of u> n by means of a pre- 
filtering, demodulation, and post-filtering means to generate a frequency error 70 (Fig. 4). 
Compensation is applied to the error signal to update the estimate of u> n such that the notch output 
25 error 80 (Fig. 5) is minimized. The RANC of the invention is preferably operated as a closed-loop 

system of, for example, about 10Hz bandwidth, and runs in parallel with the controller. The notch filter 
is thereby implemented as a time-varying filter with the natural frequency as an input variable instead of 
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a constant. The invention is fast enough to handle step changes in u> n and yet remains robust in the 
presence of noise. The invention exploits the phase response of notch filters to locate uj n : . Near the 
notch frequency the phase is approximately linear and about the notch frequency the gain is 
approximately symmetrical. 

5 

The preferred embodiment of the invention is now described with respect to Figs. 2-6. Fig. 2 
shows the invention in comparison to the prior art shown in Fig. 1 . Rather than assuming harmonic 
noise of constant frequency, the present invention accounts for a corrupted sensor 13 including 
10 harmonic noise of time varying frequency oj n (t). The RANC 22 and notch filter 14 employ an initial 
estimate 20 of the harmonic frequency, u) n (0). The RANC samples both input and output of the notch 
filter and provides to the notch filter updated frequency estimate oo n (k). Note that elements 20,22,14 
may in fact be a plurality of such elements to handle a plurality of resonance features in a system. 



15 A sample system employing RANC for structural resonance compensation is shown in Fig. 3, 

including rate command 30, rate integrating gyroscope ("RIG") 32, gyro noise 34, compensation 
means 36, drive command 38, amplifier 40, motor torque constant 42, disturbance T d 44, gimbal with 
structural resonance 46, integrator for gimbal rate (inertial) 48, angular accelerometer 50, accelerometer 
noise 52, and feedback compensation 54. An inherent characteristic of this application is that tThe 

20 resonance amplitude trends to noise level as u> n (k) approaches oo n (t), thus rendering conventional 
techniques impractical. 



Fig. 4 shows details of the preferred RANC of the invention in conjunction with notch input 72 
and notch output 74. The preferred RANC comprises first pre-filter 60, second pre-filter 62, 
25 demodulator and post filter 64, compensation means 66, reference signal 68, frequency update 
u> n (k) 76, and error signal e w 70. 
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Fig. 5 shows details of the preferred pre-filters. The first pre-filter comprises zeta ratio means 84 
and band pass filter 82 to provide notch error 80. The zeta ratio attenuates the notch input 72 to match 
the attenuation of the notch filter at w n (k) such that the error at oj n (k) approaches zero as w n (k) 
approaches the resonance frequency of the input signal. The second pre-filter comprises band pass 
5 filter 86 and low pass filter 88 to provide reference signal 68. The band pass filters attenuate noise and 
disturbances at frequencies below and above u> n (k) and the low pass filter produces a 90 degree phase 
lag at w n (k) between the reference 68 and notch error 80 by means of a second order filter. 



Fig. 6 shows details of the preferred demodulator, post-filter, and compensation means. The 
10 demodulator and post-filter comprise multiplier 90, low pass filter 92, and sign detection function 94. 
The compensation means comprises integral compensation 67. The low pass filter is preferably second 
order with a bandwidth about one decade below the expected value of u> n (k). 



The advantages of the invention include the following: (1) The invention provides in a gimbaled 
15 turret or like structure a line-of-sight stabilization improvement over the entire range of gimbal position, 
temperature and vehicle maneuver. (2) The invention provides increased robustness to 
interchangeably of components and variations in assembly (e.g., preload, joint stiffness). (3) The 
invention relaxes stiffness and preload tolerances during assembly. (4) The invention helps reduce the 
size and weight of structures by relaxing the requirement that resonances be kept high in frequency. (5) 
20 The invention improves phase margin response -notches more narrow than conventional can be used. 

(6) The invention only requires a rough initial estimate of u) n (in the example, within 35%, or ±80Hz). 

(7) The invention does not require an external reference signal. (8) The invention works independent 
of source type generating the resonance, i.e., the resonance source can be additive harmonic noise or 
mechanical structure. (9) The invention is computationally efficient for realtime applications (12-18th 

25 order overall). (10) The sampling period requirements of the invention are comparable to digital notch 
filters. (11) No spectral (FFT) or system identification techniques required. (12) The invention can be 
implemented with analog controllers and circuits. (13) The invention reduces the need for measuring 
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the structure of each particular system. (14) On systems that must be measured, the RANC simplifies 
the measurement process by automatically stabilizing the controller such that closed-loop 
measurements are possible. (15) The invention operates in a closed feedback loop ensuring that the 
notch cancels the resonance. (16) The invention is applicable, for example, to the compensation of 
5 gyroscope spin frequency noise harmonics. 

Features of the invention include the following: (1) The invention monitors notch error and 
updates the frequency estimate to most efficiently attenuate the resonance, in that for time-varying 
frequencies, the best estimate is not necessarily the instantaneous frequency. (2) The invention does 

10 not require a constant input resonance amplitude, and so is useful for compensation of structural 
resonances where the main objective is to reduce the resonance to zero amplitude. (3) Multiple 
RANCs can be implemented in a single system, each operating in its own frequency range, and the 
designer can adjust the operating range in the pre-filters to minimize coupling between the RANCs. 
Reducing the frequency range of operation (by adjusting the pre-filters) allows for a larger number of 

15 RANCs implemented simultaneously, each operating in its own frequency range. (4) The invention 
continues running in parallel with the controller to update the estimate of w n if the structural resonance 
changes for any reason, is not affected by controller input commands or uncorrelated external 
disturbances, and provides for straightforward implementation of graceful degradation logic. (5) The 
invention provides for a compact, modular design with minimal integration impact. 

20 

The invention operates most efficiently under the following conditions: (1) Signal-to-Noise-Ratio 
("S/N") > 1 for the resonance being identified (i.e., S/N > 1 near the frequency of interest, u> n ). If the S/N 
drops, the estimate remains relatively constant and is not updated until the S/N is again greater than 1 . 
(2) No other uncompensated harmonics exist with S/N > 1 in the frequency range of operation (u> n 
25 ±35%, or ±80Hz in the example). Harmonics that do exist near u n can be filtered with conventional 
notch filters. Low frequency notches for such harmonics can be placed in the RANC closed-loop path 
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without affecting the rate or acceleration loops. Additional RANCs can be used if these harmonics are 
varying in frequency. (3) A sampling rate of at least 3 times w n is preferred for digital implementations. 

Additional embodiments of the invention can be used for automatic notch depth adjustment in 
5 addition to frequency and for torque disturbance rejection of harmonic disturbances (e.g., disturbances 
caused by helicopter rotor frequency). Non-military applications of the present invention include 1) 
adaptive harmonic noise identification and filtering and 2) control of flexible structures. Specific 
potential applications are: 

1 ) stabilization platforms; 
10 2) gyroscopic rate sensors; 

3) computer hard-drives; 

4) vehicle body bending compensation; and 

5) flexible manipulators and robotics. 



15 Industrial Applicability : 

The invention is further illustrated by the following non-limiting example. 



Example 1 

A "hardware-in-the-loop" system 100 as shown in Fig. 7 was implemented which provided for 
20 realtime simulation of a yaw/pitch and azimuth/elevation gimbal system. The RANC was implemented 
on yaw and pitch control loops with a 3600Hz update rate for the controller and gimbal model. Gimbals 
were modeled with one structural resonance each, yaw: 349Hz and pitch: 219Hz. The hardware was 
selected because it provides a significant source of electrical noise. The added components beyond 
those of Figs. 2-6 are gyro reference 102, hardware demodulation noise 104, analog-to-digital 
25 converters 106,118, digital-to-analog converters 108,116, amplifiers 110,114, summing node 120, and 
gyro demodulator 112. 
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With the RANG off, the system proved unstable with initial estimates of oj n for yaw and pitch at 
310Hz and 200Hz, respectively. With RANC on, the system was stable even with a step change from 
325/200Hz (yaw/pitch) to 349/219Hz and could accommodate step rate commands, that is, the RANC 
operated properly despite the presence of step rate commands, Structural resonance amplitude was 
5 reduced to noise level upon conversion of the RANC. For initial estimate errors within ±20%, the 
invention showed a 0.2 sec settling time. 



The preceding example can be repeated with similar success by substituting the generically or 
specifically described components and/or operating conditions of this invention for those used in the 
10 preceding example. 



Although the invention has been described in detail with particular reference to these preferred 
embodiments, other embodiments can achieve the same results. Variations and modifications of the 
present invention will be obvious to those skilled in the art and it is intended to cover in the appended 
15 claims all such modifications and equivalents. The entire disclosures of all references, applications, 
patents, and publications cited above are hereby incorporated by reference. 



